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[57] ABSTRACT 

A method for positioning a scanning instrument to point 
toward the center of the desired scan wherein the scan is 
achieved by rotating unbalanced masses (RUMs) rotating 
about fixed axes of rotation relative to and associated with 
the instrument, the RUMs being supported on drive shafts 
spaced from the center of the mass of the instrument and 
rotating 180 degrees out-of-phase with each other and in 
planes parallel to each other to achieve the scan. The 
elevation and cross-elevation angles of the instrument are 
sensed to determine any offset and offset time rate-of- change 
and the magnitude and direction are converted to a RUM 
cycle angular velocity component to be superimposed on the 
nominal velocity of the RUMs. This RUM angular velocity 
component modulates the RUM angular velocity to cause 
the speed of the RUMs to increase and decrease during each 
revolution to drive the instrument toward the desired center 
of the scan. 


6 Claims, 1 Drawing Sheet 



U.S. Patent 


Jul. 2, 1996 


5,531,093 



8 



5 , 531,093 


1 

MEANS FOR POSITIONING AND 
REPOSITIONING SCANNING 
INSTRUMENTS 

ORIGIN OF THE INVENTION 5 

The invention described herein was made by employees 
of the United States Government and may be manufactured 
and used by or for the Government of the United States of 
America for Governmental purposes without payment of 10 
any royalties thereon or therefor. 

HELD OF THE INVENTION 

This invention in one of its aspects relates to scanning j5 
devices or instruments focused on objects in or from outer 
space. In a more specific aspect the invention is concerned 
with instruments whose scanning is produced by rotating 
unbalanced-mass devices, and particularly gimballed scan- 
ning instruments. In a still more specific aspect the invention 2Q 
pertains to means for positioning and repositioning such 
scanning instruments. 

BACKGROUND OF THE INVENTION 

As can be imagined, scanning instruments are an impor- 25 
tant aspect of space science. In addition to their use in 
scanning the earth and other planets, x-ray, gamma-ray, and 
similar scanning instruments perform additional functions 
important in space exploration. Examples of such instru- 
ments are sensors, telescopes and electronic devices carried 30 
by space platforms such as a space shuttle, a space station, 
by experimental balloons, and by free-flying spacecraft. 

To achieve the scan pattern a drive means must be 
provided which impart to the payload an oscillatory motion. 
Such drive means are generally known, particularly in space 35 
exploration. Various forms of machines or apparatus have 
been employed for controllably conferring on scanning 
instruments predetermined scan patterns. They include con- 
trol moment gyroscopes, reaction wheels, torque motors, 
reaction control systems, and various combinations of such 40 
apparatus. 

One disadvantage of utilizing such scan generating 
devices is power consumption. For this reason, whether 
scanning with a ground-based, space-based, or balloon- 45 
borne gimballed payload a preferred drive means which is 
particularly effective is a rotating unbalanced-mass, or 
RUM, device. This device is the subject of our U.S. Pat. No. 
5,129,600. 

RUM devices are a new and efficient way to generate scan 50 
patterns using gimballed payloads such as x-ray telescopes 
or other scientific instruments. A RUM device consists of a 
mass, m, on a lever arm r, located at a distance, d, from the 
center- of-mass of the gimballed payload on which it is 
mounted. The mass is driven at a constant angular velocity 55 
co which produces a cyclical centrifugal force mco 2 r on the 
payload. This force, in turn, produces a cyclic torque, about 
the payload center-of-mass, with an amplitude of mco 2 rd. 

The period of this cyclic torque is the same as the period of 
rotation of the RUMs. Two RUM devices are required to 60 
scan with-gimballed payloads. RUMs are mounted on each 
end of the payload and they rotate 180° out-of-phase pro- 
ducing a cyclic torque couple having an amplitude of 
2 mco 2 rd. 

RUM devices are superior to previous scanning devices in 65 
terms of power, weight, cost, and accuracy, but such appa- 
ratus is still not totally satisfactory. Even though operating 
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power requirements are less than those required for operat- 
ing other scan generating devices, the required positioning 
and repositioning, or pointing, means are subject to 
improvement. RUM devices currently require an auxiliary 
control system to position and reposition the scan pattern 
relative to a target or a number of targets. Such control 
means confer on the payload or instrument a slow comple- 
mentary motion that keeps the Scan centered on the target. 

Prior methods of generating control torques for pointing 
freeflying/tethered satellites and gimballed payloads 
employed reaction wheels, control moment gyroscopes 
(CMGs), reaction control system (RCS) thrusters, and gim- 
bal torque motors. 

Pointing and scanning with reaction wheels, CMGs, and 
gimbal torque motors characteristically require a great deal 
of power. Reaction wheels and CMGs also require a momen- 
tum desaturation system. RCS systems can only generate 
control torques until the RCS propel] ant is depleted. In 
addition, they are also normally nonlinear devices that 
produce either full thrust or no thrust. This characteristic 
makes them unsuitable for applications where precise point- 
ing and scanning are required. Gimbal torque motors require 
gimbals and a base structure to torque against, which renders 
them unsuitable for free-flying spacecraft and satellites. 
Also, reaction forces and torques acting against the base 
structure tend to couple back into the payload or instrument 
being pointed, causing pointing/scanning errors and/or sta- 
bility problems. It can be seen, then, that despite the desir- 
ability of RUMs, there is room for improvement in then- 
operation. A needed improvement is the elimination of such 
pointing, that is, positioning and repositioning, equipment, 
normally referred to as auxiliary control systems. We have 
now found that this can be accomplished. 

SUMMARY OF THE INVENTION 

As indicated hereinbefore, pointing means are provided 
for positioning and repositioning a scanning instrument 
when the instrument is offset from its center- of- scan and 
must be pointed to that center-of-scan. The scanning instru- 
ment is the type whose scan pattern is achieved by rotating 
unbalanced- masses (RUMs). Mounted on the scanning 
instrument are first and second RUMs supported on respec- 
tive drive shafts. They are spaced from the center-of-mass of 
the instrument, and adapted to rotate 180 degrees out-of- 
phase with each other, with their planes-of-rotation parallel 
to each other, and at a constant angular velocity. The 
centrifugal forces caused by rotation of the RUMs create 
time-varying relatively large-amplitude/high-frequency 
operating or nominal reaction forces and torques which act 
on the instrument to move its line-of-sight in a predeter- 
mined, repetitive, scan pattern. This invention is thus based 
on the discovery that, in RUM operation, if we superimpose 
a cyclic angular velocity component on top of, or in addition 
to, the nominal constant angular velocity component of the 
rotating RUMs, we can introduce an additional force, and 
hence a torque, on the device on which the RUMs are 
mounted in order to position and reposition the scan center. 
And, as indicated, the period of this cyclic component is the 
same as the period of rotation of the RUMs. The means for 
pointing the RUM-mounted instrument according to the 
invention hence include sensing means producing elevation 
and cross-elevation departure angles from a given center- 
of-scan, and sensing means producing the rate of change in 
the elevation and cross -elevation departure angles. Also 
included is a programmable logic controller means deter- 
mining scan errors and rate-of- change in the scan errors in 
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both elevation and cross-elevation axes from the departure 
angles and their rate-of-change, and for converting these 
errors and error rates-of-change to a RUM cyclic angular 
velocity component and to a locus in the RUM orbit where 
the peak of this cyclic component is to be applied. Means 5 
responsive to the controller means superimpose on the RUM 
constant angular velocity during a given cycle, the cyclic 
component phased in the RUM cycle to induce a torque 
which when combined with the operating high frequency 
torque produces a resultant torque vector over the RUM 10 
cycle which acts to compensate for the departure from the 
center-of-scan. 

DETAILED DESCRIPTION OF THE 

INVENTION 15 

In addition to eliminating an auxiliary control system, and 
this is important as emphasized in Ser. No. 08/123,629 filed 
Sep. 15, 1993, and now U.S. Pat. No. 5,396,815, the process 
of augmenting or modulating the constant angular velocity 20 
required for scanning with RUM devices yields some inter- 
esting results. These results are quite surprising in the light 
of what was learned during the operation of RUM devices 
described in U.S. Pat. No. 5,129,600. Throughout that patent 
the fact that drive means are adapted for rotatably driving the 2 5 
shaft at a constant angular velocity is confirmed. It is pointed 
out that when steady state operating conditions are attained, 
it is desired that the angular velocity of the masses not be 
accelerated or decelerated. The angular velocity is adjusted 
up or down for shorter or longer scan periods, but once the 30 
scan period is established, the velocity must be constant to 
maintain that scan period. 

Herein the desired scan period is still maintained by 
retaining a constant angular velocity, but superimposed on 
that angular velocity, once per cycle, is a modulating cyclic 35 
component. Since this cyclic component is introduced on 
top of, or in addition to, the nominal angular velocity once 
each revolution by the rotating unbalanced-masses, a net 
torque is generated each revolution. This generated net 
torque is, in effect, a vector. It has magnitude and direction. 40 
The magnitude of this torque vector is proportional to the 
amplitude of the cyclic component of the angular velocity, 
and its direction is a function of the point or locus in the orbit 
where the cyclic component’s peak occurs. It remains, then, 
to determine the magnitude of the resultant torque vector, 45 
and to define the locus in the circle where the cyclic 
component peak occurs-in other words, where in the 360 
degree cycle or RUM orbit the peak of the cyclic component 
of the RUM angular velocity should be effected. This, of 
course, is engineering within the skill of the art. Program- 50 
mable logic controllers are commonly employed in industry 
which respond to position and rate sensors. They are in wide 
use in the machine tool industry for lathes, milling 
machines, and the like. It will be apparent that modifications 
of these computerized sensing devices can be made to 55 
establish the cyclic component’s amplitude and phase in a 
given RUM revolution. From a process point of view, on the 
other hand, it will be helpful to discuss the steps of the 
invention herein. This process includes: measuring elevation 
and cross -elevation angles and the rate-of-change of these 60 
angles to determine any offset and offset time rate-of- 
change, calibrating the magnitude and direction components 
of the offset about the elevation and cross-elevation axes, 
converting these components to a RUM angular velocity 
cyclic component for superimposition on the nominal angu- 65 
lar velocity component, and to a locus of the RUM 360 
degree orbit where the peak of this cyclic component is to 
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occur, accelerating the speed of the RUMS and decelerating 
the RUMs each cycle to produce the desired angular veloc- 
ity, thereby modulating the angular velocity to generate a 
resultant torque vector each cycle whose direction is depen- 
dent upon the location of the locus in the. RUM orbit where 
the peak of the cyclic component of the RUM angular 
velocity occurs, and which acts to compensate for the 
departure from the center-of-scan. 

Although the determination of the locus in the RUM orbit 
where the peak of the cyclic component of the angular 
velocity occurs and the magnitude of this peak are within the 
skill of the art, it will also be helpful to describe one method 
for calibrating and determining these variables. It has been 
pointed out that the resultant torque vector magnitude is 
proportional to the magnitude of the cyclic component of the 
RUM angular velocity, and that its direction is a function of 
the locus in the orbit where this peak occurs. Considering 
first the direction of the torque vector, telescope-mounted 
attitude sensors indicate the orientation of the telescope 
line-of-sight (LOS) relative to its base, and all angles are 
calibrated to this 0 degree baseline. Attitude sensors, in the 
form of gimbal incremental encoders, measure changes in 
elevation and cross-elevation gimbal angles relative to this 
baseline. From these changes, every T seconds (e.g. 
T-0.0075 sec), the elevation and cross-elevation angles are 
estimated by summing the encoder outputs. The resulting 
estimated elevation and cross-elevation angles are denoted 
herein as 0*(nT^ Cfl „-jT) and d x (nT pscarr }T) 9 respectively, 
where n=l,2, . . . , j=0,l,2, . . . , N-l, and T pscan =NT. These 
estimated angles, and the commanded elevation and cross- 
elevation angles at a time nTp^ Cfln -jT, denoted by Q EC (nT p - 
scan- jT) and 0 xc (nT pjcan -jT) respectively, can be used to 
calculate the errors in the scan center. The errors in the scan 
center at time nT plco „, Av0 fic (nT pscan ) and Ave Xc (nT pscan ), 
can be derived from equations (1) and (2). 

N-l ( 1 ) 

Av%Ee(nTp Scan ) — 1 IN £ [&Ec(nTp Scan —jT) — &E(nTp Scan — jT)] 

7=0 

N-l m . (2) 

AvQxe( n Tpscan) — 1 IN £ [6xc ( vTp Scan —jT) — QxjnTpscan -jT)] 

7=0 

It will be noted that the errors in the scan center are an 
average (Av) of N instantaneous scan errors equally spaced 
in time over a RUM scan period. These errors in scan, or 
calculated averages, are components used in combination 
with the time rate-of-change of the scan errors as will be 
described. 

The time rate-of-change of the scan errors are similarly 
derived. Tachometers measure the rate-of-change in the 
gimbal angles. The tachometer outputs are sampled every T 
seconds or N times over a scan period, T scan seconds. These 
sampled tachometer outputs for the elevation and cross- 
elevation gimbals, denoted by Q^nT pscan -jT) and Q^fnT^ 
scan-jT) respectively, are subtracted from the commanded 
gimbal rates Q £c (nT pscan -jT) and &xc(nT pjcan -jT) t0 pro- 
duce the gimbal rate errors, &^(nT^ Cfln -jT), and Q. Xe (nT p - 
scan- jT. These are averaged over N values in a RUM 
revolution to yield the following equations. 

N-l . (3) 

AvO,Ee(nTp Scan ) — 1 IN £ [^ECfaTpscan — jT) — £l}j,nTp X can — jT)] 

7=0 

N-l (4) 

AvQ.xe(nT pscan )~l/N £ [Qxc (nTpscan—jT) — Qx(nTp S can—jT)] 

7=0 

It can be seen that the differences between the actual and 
the commanded elevation and cross-elevation angles are 
averaged using equations (1) and (2) in order to obtain Avd Ee 
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and Av0 Xe . In the same manner, Av£l Ee and Av£l Xe are 
determined using equations (3) and (4). Thus, once every 
scan period, which is T pscan seconds, equations (1) thru (4) 
are solved to yield the estimated scan errors, and the time 
rate-of-change of those errors. By using the values for the 5 
errors in the center-of-scan and the time rate-of-change of 
those errors derived from equations (1) thru (4), the param- 
eters §£^2 and 5£2 PP3 can be determined. These parameters 
are the elevation and cross-elevation components of the 
desired amplitude for the cyclic component of the RUM 10 
angular velocity for the next RUM revolution. To find these 
parameters, the scan errors and error rates from equations (1) 
thru (4) are input into proportional-integral controllers with 
rate feedback. The integrals of the scan errors are thus 


determined by the following equations. 15 

Av/ £e (n^ Jca , 1 Mv7 & [(«-l)7 7 / ,, cfl J+0 £e (nr i ,, C£J J (5) 

Avlxei n ^psca^Avl Xe [{n— V)T psca ^Q x JjiT pscar ^ ( 6 ) 

where initially AvI Pe (0)=AvI^ e (0)=0. 20 


From these integral values and the averages derived by 
equations (1) thru (4), 5Q PP2 and 5£2 PP3 can be determined 
by equations (7) and (8). 

pscan y 25 

AvQ Ee (nT pscan )] (7) 

^RP3( n ^pscan) = ^R[k p AvQ x JriT pscan y\-kfAvI Xe (nT 

pscan^ 

AvQ. Xe (nT pscan )] ( 8 ) 

The desired instantaneous value for the cyclic component 30 

of the RUM angular velocity in the (n+1) revolution of the 
RUMs is given by equation (9). 

8^A n A’scAArr^77=6n /? p3(nr PSCAN r)COS[0 fiC (nrp 5C/ yv+fcrj]— 

7N [ Q pscAN^kT ) ] (9) 35 

where k=f), 1,2,..., N-l. The angle 0 PC is the commanded 
RUM angle that the RUM servos are slaved to follow. 

This control law specifies the additional, augmented, 
RUM rate, 5£2 pc (nT P5CAiV +kT), desired at a time nT PSCAN + 4Q 
kT, to be added to the nominal commanded RUM rate, as 
determined from the elevation and cross-elevation compo- 
nents previously derived and described. This control law 
inherently generates the proper cyclic component of the 
RUM angular velocity, with proper magnitude and phase 45 
values, that produces a net torque over the (n+1) RUM cycle 
that acts to recenter the scan. 

THE DRAWING 

At this juncture it will be helpful to describe an instrument 50 
which is operated by rotating unbalanced-masses. One such 
instrument is shown in the accompanying drawing. 
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FIG. 1 is an isometric view of a double-gimballed scan- 
ning instrument showing the rotating unbalanced-masses 
and their rotation orbits. 


SPECIFIC EMBODIMENTS 

Gimbals can be mounted on a space station, a space 
shuttle, hung from a scientific balloon, or mounted firmly on 
the ground. However for the purposes of illustration herein, 
assume that the body or payload to be pointed, say a 
telescope 2, is supported by elevation and cross-elevation 
gimbals 4 and 6 respectively. The instrument or payload 2 is 
carried by a gimbal 6 through a known axle system which 
permits it to move horizontally relative to payload base 8. 
Cross-elevation gimbal ring 6 is carried by elevation gimbal 
4 permitting vertical movement with respect to base 8. In 
some instances gimbal 6 will be a ring. In the embodiment 
herein the base of gimbal 4 is embedded in or secured to a 
platform 8. In order to permit payload movement the axle 
system includes two axle means 10 and 12. Herein axis 12 
is the P 3 axis and 10 is the P 2 axis. In addition, to discuss 
front RUM 20 and rear RUM .22 are shown, along with the 
telescope line-of-sight (LOS) or P x axis. The front of the 
telescope, then, is the end depicting the direction of RUM 
rotation. When the line-of-sight of the instrument is perpen- 
dicular to the planes-of-rotation of the RUMs, the scan is 
circular. When the line-of-sight of the instrument is parallel 
to the planes-of-rotation of the RUMs, the scan is a linear 
scan. 

Positioning and repositioning, or pointing, means, termed 
auxiliary control systems, are normally a part of a payload 
operated by RUMs. These include such elements as gears, 
stepper or torque motors, cams, pitman arms, linkages, and 
even pulleys. Herein all of those mechanical parts are 
eliminated and replaced by the operation of the RUMs as 
described hereinbefore. 

Having been given the teachings of this invention, varia- 
tions and ramifications will occur to those skilled in the art. 
Whereas a gimballed RUM instrument has been described, 
it will be appreciated that instrument-mounted optical atti- 
tude sensors and gyroscopic inertial rate sensors are avail- 
able for use on freely suspended instruments, say in space, 
on tethers, or on balloons. Further, the method for deter- 
mining the RUM cyclic angular velocity component can best 
be implemented in a computer program which can more 
readily iterate the functions and determine solutions to 
equations (1) thru (9). The key algorithms in the program are 
set forth in Table a at lines 236 to 356. 
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Table a 


175 c 

176 THRBOTHRC 

177 THRBHTHRBC 

178 THRBE=0 .0 

179 THRBEI=0.0 

180 C 

181 thgxco*+oo.oo*dtr 

182 THGXC=THGXCO-THGXCM*COS ( THRC ) 

183 OMGXC=OMGXCM*SIN{THRC) 

184 THGXH*TBGXC-(10.0*DTR) 

185 THGXEI=0.0 

186 C 

187 

188 THGECO=00.00*DTR 

189 THGEC*THGECO+THGECM*SIN ( THRC ) 

190 OHGEC=OMGECM*COS ( THRC ) 

191 THGEH*THGEC-(90.0*DTR) 

192 THGEEI=0.0 

193 C 

194 DWRP 3*0.0 

195 DWRP2*0.0 

196 C 

197 OMGXEA*0.0 

198 THGX£A=0 .0 

199 WGXIC-0.0 

200 XN*1.0 

201 C 

202 CMGEEA-0.0 

203 THGEEA*0.0 

204 HGEIC-0.0 

205 EN=1.0 

206 C 

207 C INITIAL CONDITIONS FOR PLANT 

208 THRA=THRAC 

209 OMRA=0 . 0 

210 TAURA— 0 . 0 

211 C 

212 THRB=THR3C 

213 OMRB=0.0 

214 TAURB=0.0 

215 C 

216 THGX=THGXH 

217 OMGX=0 . 0 

218 OMGXM=0.0 

219 TAUGX-0.0 

220 C 

221 THGE-THGEH 

222 OMGE=0.0 

223 OMGEM=0.0 

224 TAUGE=0.0 

225 C 

226 DO 12 1=1,6 

227 12 BB ( I ) =0 . 

228 TMIN=10 . 0 

229 WRITE (2,15) 

230 15 FORMAT ( 20X, 'STEADY STATE CONDITIONS 25X, 'PEAK VALDES ',/ , 

231 *2X, 'MA' ,2X, 'T rum A' ,3X, 'T ram B',5X,'T »1',3X,'T «1' , 5X, 'THETA 

232 *x*l' ,3X,' THETA •!' ,5X, 'POWER' ) 

233 C SIMULATION BEGINS HERE «******************************************’ 

234 100 CONTINUE 

235 C 
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23S"C — TEST FOR TIKE TO CYCLE THRU CONTROL MICROPROCESSOR 

237 IF (XNTC.GT.O)GO TO 200 

238 C 

239 C READ INCREMENTAL ENCODER OUTPUTS: 

24 0 DTHRA=THRA-THRAH 

241 CALL QUANT ( IQENC , EHCBTS , ENCRG, DTHRA, DTHRAQ ) 

242 DTHRB-THRB-TBRBH 

24 3 CALL QUANT (IQENC, EHCBTS , ENCRG, DTHRB , DTHRBQ ) 

244 DTBGX=THGX-THGXH 

24 5 CALL QUANT ( IQENC , ENCBTS , ENCRG , DTBGX , DTHGXQ } 

246 DTHGE=THGE-TEGEH 

247 CALL QUANT (IQENC, ENCBTS, ENCRG, DTHGE , DTHGEQ ) 

248 C 

249 C UPDATE ESTIMATED PLANT STATES: 

250 THRAH=THRAH+DTHRAQ 

251 THRBB=THRBH+DTHRBQ 

252 T3GXH»THGXH+DTHGXQ 

253 THGEH=THGEH+DTBGEQ 

254 C 

255 C SOLVE CONTROL LAW EQS : 

256 C X-EL GIMBAL CONTROL LAW: 

257 TSGXC=THGXCO-THGXCM*COS ( THRC } 

258 OMGXC=+OHGXCX*SrN(THRC) 

259 THGXE=THGXC -THGXH 

260 OHGXE*CMGXC-OMGXM 

261 THGXEA=<THGXEA«CXH-1.0)/XH) + (THGXE/XX) 

262 CKGXZA” ( QMGXZA* ( XN-1 . 0 ) /XN ) + { OHGXZ/XN ) 

263 XN-XN+1.0 

264 C 

265 C EL GIMBAL CONTROL LAW: 

266 THGEC=THGECO+THGECM*S IN ( THRC ) 

267 OMGEC 5 *OMGECM*COS (THRC) 

268 THGEE™THGEC»THGEH 

269 OHGEE-OMGEC-CWGEM 

270 TaGEEA*(THGEEA*(EN-1.0 )/EN)+(THGEE/EN) 

271 OMGEEA= ( OMGEEA* ( EH- 1 . 0 ) /EN ) + ( OMGEE/EN } 

272 EN— EN+1 . 0 

273 C 

274 C CORRECTION TERM FOR POINTING WITH RUM'S: 

2 7 5 DVRC=DWRP3*COS ( THRC ) -DWRP2 *SIH ( THRC ) 

2 76 LDTHRC=DWRC *TS 

277 C 

278 C RUM A SERVO CONTROL LAW: 

279 DTHRAE=DTHRAC-DTHRAQ+LDTHRC 

2 90 TRAC=IRAS*(KRR*DTHRAE+KRP»THRAE+KRI*THRAEI) 

291 CALL QUANT ( IQTQM,TQMBTS , TQMRG, TRAC, TRACQ) 

232 TRAM=(1.0+CRTQM*(ABS(SIN(FRTQH*THRA) )-1.0) )*TRACQ 

283 C 

284 C RUM B SERVO CONTROL LAW: 

285 DTHRBE=DTHRBC-DTER3Q+LDTHRC 

286 TRBC=IRBH* (KRR*DTHRBE+KRP*THRBE+KRI *THRBEI ) 

287 CALL QUANT ( IQTQM , TQMBTS , TQMRG , TRBC , TRBCQ ) 

288 TRBM=( 1 . O+CRTQH* (ABS (SIN(FRTQM*THRB) )-l .0) )*TRBCQ 

289 C 

290 C FOR NEXT COMP CYCLE: 

291 C READ/ C0HPUTE NEW COMMANDS, IF CHANGED: 

292 IF (T.LT.TCHNG)GO TO 150 

293 DTHRC=2.0*DTERC 

294 DTHRAC=»2 .0*DTHRAC 

295 DT9R3C=*2 . 0 ’DTHRBC 

296 QMGXCM»2.0*OMGXCM 

297 OHGEC=OMGEC 

298 TCHNG-T+DTCHNG 

299 150 CONTINUE 

300 C UPDATE CONTROLLER STATES: 

301 THRC=THRC+DTHRC 

302 IF ( ABS ( THRC } . LE - TVF I ) GO TO 155 

303 THRC=*THRC-SIGN(TW?I,THRC) 
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304 C 

30 5 CHGXZAS»OHGXEA 

306 TSGXEAS-THGXEA 

307 WGXPC=*KGXP*THGXEAS 

308 IF { ABS ( WGXPC ) , GT . WGXPCL ) WGXPC=S IGH ( WGXPCL, WGXPC } 

30 9 WGXIC^WGXIC+KGXI *THGXEAS 

310 IF ( ABS ( WGXIC ) , GT . WGXICL ) WGXI OS IGN ( WGXICL , WGXIC ) 

311 DWRP3=KGXR* ( WGXIC+WGXPC+OHGXXAS ) 

312 

313 C 

314 CMGEEAS =0MGEEA 

315 THGEEAS =THGE£A 

316 WGEPC=$GEP*THGEEAS 

317 IF(ABS(WGEPC) .GT.WGEPCL)WGEPC*SIGN(WGEPCL,WG£PC) 

318 WGEIC=WGEIC+KGEI*THG£EAS 

219 IF ( ABS ( WGE IC ) * GT . WGEICL ) WGEIOSIGH ( WGEICL, WGEI C } 

32 0 DWRP2= : KGER* (WGEIC+WGEPC+OHGEZAS ) 

321 C 

322 TEGXEA— 0 . 0 

323 THGEEA=0.0 

324 OMGXEA~0,0 

325 OMGEEA^Q.O 

326 XU =*1,0 

327 EN=*1.0 

328 C 

329 155 CONTINUE 

330 C RUM A: 

331 THRAEI =THRA£I+THRA£ 

3 32 THRAOTHHAE+DTHRAE 

333 THRAC=*THRAC+DTHRAC 

334 IF (ABS (THRAC ) *LE ,TWPI)GO TO 160 

33 5 THRAOTHRAC-SIGN ( TWPI , THRAC ) 

336 THRA * THRA-SIGN ( TWPI , THRAC ) 

33 7 THRAH=TH RAH -SIGN (TWPI, THRAC ) 

338 160 CONTINUE 

339 C 

340 C RUM B: 

341 THR3EI-TBRBEI+THRBE 

342 THRBE*THRBE+DTHRBZ 

34 3 THRBC=*THRBC+DTHRBC 

344 I? {ABS (THR3C) .L£. TWPI) GO TO 165 

34 5 THRBOTSRBC-SIGN { TWPI , THRBC ) 

34 6 TSR3 * TBRB-SIGN { TWPI , THRBC ) 

347 THRBH=THRBH~SIGN(TWPI,TERSC) 

348 165 CONTINUE 

349 C 

350 C X-EL GIMBAL; 

351 THGX2I=T5GXEI+THGXZ 

352 C EL GIMBALt 

353 THGZZI=*THGEEI+THGEE 

3 54 C RESET MICROCONTROLLER COUNTER 

3 55 KNTC-KNTCM 

356 200 CONTINUE 

357 C 

358 C COMPUTE DISTURBANCE TORQUES 6 SUM WITH CONTROL TORQUES **** ********* 

359 SA-SIN (THRA) 

3 60 CA=*COS ( THRA ) 

361 SB~SIN(THRB) 

362 CB*COS ( THR3 ) 

363 SX=S IN (THGX ) 

364 CX=COS ( THGX ) 

365 SE=S IN ( THGE ) 

366 CE=COS ( THGE ) 

367 C 

368 TRAD=+RMGA* ( THGX* SA* SE -CA*C£ ) 

369 TRAP — - TAURA 

370 TRAT^RAM+TRAF+TRAD 

371 C 

37 2 TRB D » - RMGB * ( THGX * S B * SE -CB * CE ) 

373 TR3F--TAURB 

374 TRBT=TRBM*TR3F+TRBD 
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c 

TGXD-DHHA*OMRX*OMRX*CA+DRMB*OMM*OHRB*CB 
TGXD~TGXD-MGA*SE* ( DA*THGX+KA*CA) 

1 +MGB * SE * ( DB *THGX+RB * CB ) 

TGXT*-TAUGX 

TG XT*TGX?+TGXD+TGXDI ST 
C 

TGED»+MGA*(DA*CE+RA*SA*SE)-HGB*{DB*CE+RB*SB*SE) 

1 -DRMA*OHBA*OMBA*SA-DRMB*OKRB*OKRB*SB 

TGEF~— TAUGE 

TGET^TGEF-HTGErH-TGEDIST 

C 

C COMPUTE DAHL MODEL PARAMETERS 

DAHLRA=OMRA*SIG* ( 1 . 0-(SIGH( 1 .0 ,OMRA) ) *TAURA/ TAUM ) 

DAHLP3=0HR3*SIG* ( 1 * 0- { S IGN ( 1 * 0 , OMRB ) ) *TAURB/TAUK ) 

DAELGX=OMGX*SIG*( 1.0-{SIGN( 1*0,OMGX) ) *TAOGX/ TAUM ) 

DAELGE=OMGE*SIG* ( 1 . 0-(SIGN( l.O/OMGE) ) *TAUGE/ TAUM ) 

C 

3oo coNTrmiT 

c 

C COMPUTE STATE DERIVATIVES ***««****•*■*•*•***'#■*♦•»**•••■*•■*■*»**■#'*■***#■**#****** 
THRAD=OMRA 
OMRAD=TRAT/IRA 
TAURAD»DAHLRA 
C 

THRBD-OMRB 

OMRBD-TRBT/IRB 

TAURBD=DAHLRB 

THGXD-OMGX 
OMGXD=TGXT/IGX 
CHGXMD-WFTAC* ( OMGX-OHGXM ) 

TAUGXD-DAHLGX 

THGED=OMGE 
CMGED=TGET/IGE 
CMGEMD=WFTAC* { OMGE-OMGEM ) 

TAUGED=DAHLGE 

' TEST FOR TIME TO STOP ********************************************** 
IF ( T . GT . TMAX ) THEN 

POWERR=(BB{ l)/0.57)**2+(BB(2)/0.57)**2 
?OWERG=(3B(3)/0.61)«-*2+(B8(4)/0.61)**2 
POWER=POWERR+POWERG 

WRITE( 2 , 5 )MB,BB( 1) ,BB(2) ,B8(3) ,BB(4) ,38(5) ,88(6) , POWER 
5 FORMAT (F4 .3,6F10.6,5X,F5.2) 

WRITE ( 3,50) IGXE, IGX, POWER, BB( 5 ) , BB ( 6 ) 

50 FORMAT (F5 .1,2X,F6.3,2X,F7.2,2X,F10.6,2X,F10.C) 
WRITE(4,60)RA£,RA,POWER,BB(5),BB(6) 

60 FORMAT ( IX, 6E10 . 3 ) 

CALL STAT(SDATl,NTOTPL, XMEAN, STDEV, RMS) 

DUM=25 .0 

WRI TE ( 7 , 6 0 ) DUH , XMEAN , STD EV , RMS 

CALL STAT(SDAT2 , NTOTPL, XMEAN , STDEV, RMS ) 

DUM=29.0 

WRITE (7,60) DUM , XMEAN , STDEV , RMS 

CALL STAT(SDAT3, NTOTPL, XMEAN, STDEV, RMS) 

DUM=26 . 0 

WRITE ( 7 , 60 ) DUM , XMEAM , STDEV, RMS 

CALL STAT(SDAT4, NTOTPL, XMEAN, STDEV, RMS) 

DUM=30.0 

WRITE ( 7 , 60 ) DUM , XMEAM , STDEV, RMS 

CALL STAT(SDAT5,NTOTPL, XMEAN, STDEV, RMS) 

POWRMS- ( RMS/ 0 . 57 ) **2 
PO WRMS T-POWRMS 
DUM=40 .0 

WRITE (7,60) DUM, XMEAM , STDEV, RMS , POWRMS., PgWRMST 
CALL STAT(SDAT6,NTOTPL,XMEAM,STDEV,RMS) 

PC WRMS = ( RMS/ 0.5 7 ) **2 
PO WRMS T = POWRMS T+ PO WRMS 
DUM-,4 1 . 0 

WRITE ( 7 , 60 ) DUM, XMEAN, STDEV, RMS, POWRMS, POWRMST 
CALL STAT(SDAT7,NTOTPL, XMEAN, STDEV, RMS) 

POWRMS - ( STDEV/ 0 . 6 1 ) * *2 



15 


5,531,093 


16 


449 POWRMS T=POWRMST+POWRMS 

450 DUM“42.0 

451 WRITE ( 7 , 60 )DUM/XKEAN,STDEV, RMS, POWRMS /POWRMS T 

452 CALL STAT ( SDAT8 , NTOTPL, XMEAN , STDEV , RMS ) 

453 POWRMS»(STDEV/Q.61)**2 

454 PQWRMST“POWRMST+POWRMS 

455 DUH*43.0 

456 WRITE (7,60) DQM, XMEAN , STOEV , RMS , POWRHS , POWRMST 

457 STOP 

453 END!? 

459 C 

460 C TEST FOR TIME TO PRINT -6 RESET KNTPR ************************«***,* 

461 IF(T .LT. 0 . 0 .OR.KNTPR.GT. 0 )GO TO 400 

462 C 

463 C "PRINT & RESET KNTPR ***tttt***t*t**.f*.*****» tt * #t „ ttt#ttottottir 

464 XNTPR^KNTFRM 

465 C 

466 400 CONTINUE 

467 C 

468 C TEST FOR TIME TO STORE VARIABLES FOR PLOTTING & RESET KNTPL ******** 

469 IF ( T . LT . 0 • 0 » OR . KNTPL .GT . 0 ) GO TO 500 

470 C 

471 C STORE VARIABLES FOR PLOTTING & RESET KNTPL ************************* 


472 

AA( 1)-T 

473 C 


474 

AA ( 2 ) =*THRA 

475 

AA ( 3 ) =OMRA 

476 

AA(4)=TAURA 

477 C 


478 

AA( 5 ) "THRB 

479 

AA(6)=OMRB 

480 

AA ( 7 ) =TAURB 

481 C 


482 

AA(8)“THGX*RTD 

483 

AA(9)“OMGX 

484 

AA(10)*OMGXH 

485 

AA(11)*TAUGX 

486 C 


487 

AA(12)“THGE*RTD 

488 

AA( 13)“OMGE 

489 

AA(14)*OHGEM 

490 

AA(15)*=TAUGE 

491 C 


492 C 


493 

AA( 16)*THRAC 

494 

AA( I7)=THRAH 

495 

AA( 1 8 } =THRAE 

496 

AA ( 1 9 } =THRAEI 

497 C 


498 

AA(20)“THRBC 

499 

AA ( 2 1 ) *THRBH 

500 

AA( 22) “THREE 

501 

AA (23) =THR3£I 

502 C 


503 

AA( 2 4 ) = ( TBGXC-THGXCO ) * RTD 

504 

AA( 25 ) =( THGXH-THGXCO ) *RTD 

505 

AA(26)=TSGXE*RTD 

506 

AA ( 2 7 ) “THGXEAS * RTD 

507 C 


508 

AA ( 2 8 ) » { THGEC-THGECO ) *RTD 

509 

AA( 2 9 ) = ( THGEH-THGECO ) *RTD 

510 

AA( 30)“THGEE*RTD 

511 

AA { 3 1 ) =THGEEAS *RTD 

512 C 


513 

AA( 32 )=OMGXC 

514 

AA(33)=OMGEC 

515 C 


516 

AA(34)=TRAC 

517 

AA{ 3 5 ) =TR3C 

518 

AA(36)=DWRP3 

519 

AA(37)=DWRP2 

520 C 


521 

AA{ 38 ) “DWRC 

522 

AA (39) “LDTHRC 
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523 C 

524 AA(40)*TRAM 

525 AA(41)*TRBM 

526 AA(42)-WGXPC*RTD 

527 AA{ 4 3 ) “WGEPC^RTD 

528 C 

529 AA(44)=*TRAF 

530 AA(45)*TRBF 

531 AA(46)*TGXT 

532 AA{47)*T GEF 

533 AA(48)»OMGXEAS*R7D 

534 AA(49)*0HGE2AS*RTD 

535 C 

53 6 C IPLSEL GIVES OPTION Or STORING SOME OTHER VARIABLES FOR PLOTTING 

537 IF (IPLSEL.EQ.O)GO TO 450 

538 AA(2)=THRAD 

539 AA(3)=OMRAD 

540 AA(4)=TAURAD 

541 C 

542 AA(5)=TH RBD 

543 AA(6)=CMRBD 

544 AA(7)«TAUR3D 

545 C 

546 AA(8)=THGXD 

547 AA(9)*OMGXD 

548 AA (10) “CHGXKD 

54 9 AA( 11)*TAUGXD 

550 C 

551 AA( 12 )*T3GED 

552 AA(13)=OM3ED 

553 AA (14) =*OMGEMD 

5 54 AA( 1 5 ) =TAUGED 

555 C 

556 450 CONTINUE 

557 WRITE ( 1, 452 )AA 

558 NTQTFL*NTOTPL+ 1 

5 59 SDAT1 (NTOTPL)*AA{25 } 

560 SDAT2 { NTOTPL ) *AA (29) 

561 SO AT 3 { NTOTPL ) *AA (26) 

562 SCAT 4 ( NTOTPL )-AA( 30 ) 

563 SDAT5 ( NTOTPL )*AA( 40 ) 

564 SDAT6 ( NTOTPL ) *AA { 4 1 } 

£65 SDAT7(NTOTPL)*AA(42) 

566 SDAT8 ( NTOTPL )*AA( 43 ) 

567 452 FORMAT { 6E10. 4} 

568 IF ( T . LT * THIN } GO TO 455 

569 C WRITE (40,* ) AA{ 4 0) 

570 C WRITE (41, * ) AA( 41) 

571 C WRITE ( 42 , * ) AA( 42 ) 

572 C WRITE ( 43 r * ) AA( 43 ) 

573 C WRITS( 26 , * )AA( 26 ) 

574 C WRITE ( 30 , * )AA( 30 ) 

575 CALL ARRFIL ( AA, BB ) 

576 455 CONTINUE 

577 KNTPIr=KNTPLH 

578 C 

579 500 CONTINUE 

530 C 

531 C TEST FLAG IN MODIFIED-EULER INTEGRATION ROUTINE ****************** 

532 IF ( INTFLG . GT . 0 ) GO TO 600 
5 83 C 

584 C PROJECT STATES & UPDATE INT. ROUTINE FLAG ************************ 
535 DO 505 1*1, K 

586 XP{r}=X(I) 

587 XDP(I)*XD(I) 

588 505 X(I)*XP(I)+XDP(I)*DT 

589 INTFLG^l 

590 GO TO 300 

591 C 

592 600 CONTINUE 
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c 

c 


c 


c 


UPDATE STATES & TIME; RESET INT. ROUTINE FLAG? DECREMENT COUNTERS ** 
DO 605 1*1, N 

XDP ( I ) -0 . 5* ( XDP { I }+XD ( I ) ) 

605 X(I)=XP(I)+XDP(I)*DT 
620 T=T+DT 
INTFLG=0 
KNTC*KNTC-1 

17 ( T . GE . 0 . 0 ) KNTPR=KNT?R- 1 
I7(T.GE-0*0)KNTPL=KNTPL-1 
GO TO 100 
END 


SUBROUTINE QUANT { IQFLG, KBITS ,XMAX,X, XQ ) 
XQ*X 

I? ( IQFLG « EQ . 0 ) GO TO 20 
XLS^ i2 (2 * 0*XMAX) / (2.0 ♦♦KBITS ) 


XMAXP*XMAX-XLSB 

XMIN--XMAX 

XDUM=XQ 

IF ( XDUM • LT . XMIN ) XDUM-XMIN 
IF ( XDUM - GT . XMAXP ) XD(JM*XMAXP 
XDUM»XDUM*XMAX+XLSB/2 • 0 
XDUM*XDUM/XLSB 
IXDUM-XDUM 
XDUM* I XDUM 
XDUM*XDUH*XLSB 
XQ-XDCJM-XMAX 
20 CONTINUE 
RETURN 
END 


SUBROUTINE ARRTIL( AA, BB ) 

REAL AA( 50) ,BB ( 6 ) 

C IF ( T -LT . TMIN ) GO TO 20 

IF ( ABS (AA( 40 ) ) .GT.BB(l) ) BB( 1)*ABS { AA(40) ) 
IF(ABS(AA(41) ).GT.BB(2) ) BB( 2 )-ABS ( AA( 4 1 ) ) 
IF (ABS ( AA( 42 ) ) .GT.BB(3 ) ) BB(3)*ABS(AA(42 ) ) 
IF (ABS ( AA(43 ) } *GT.BB( 4 ) ) BB( 4 )*ABS ( AA( 43 ) ) 
IF (ABS(AA(26) ) •GT.BB(5 ) ) BB( 5 ) -ABS ( AA( 26 ) ) 
IF ( ASS ( AA( 30))* GT • BE ( 6 ) ) BB ( 6 ) *ABS ( AA( 30 ) ) 
C 20 CONTINUE 
RETURN 
END 


SUBROUTINE STAT ( X , NTOTPL , XMEAN , STDEV , RMS ) 
DIMENSION X( NTOTPL) 

XHEAN-0 . 0 
XMEANSQ-0.0 
DO 10 1*1, NTOTPL 
RI-I 

RIM1=*RI-1.0 
RATIO* RIM1/RI 

XMEAN- { RATIO-XMEAN ) + ( X ( I ) /RI ) 

10 XMEANSQ*(RATIO»XMEANSQ) + (X(I)*X(I)/RI) 
HMS=SQRT ( XMEANSQ ) 

STDEV=SQRT ( XMEANSQ- ( XMEAN * XMEAN ) ) 

RETURN 

END 
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EXAMPLE 1 

The program in Table a was used for a telescope with 
inertias Ie=I*= 26 slug-ft 2 and RUMs, each with a mass m=5 
lb, mounted a distance d=2.5 ft from the center of gravity of 
the telescope. The RUM lever arm lengths were r=0.5 ft, and 5 
the scan period was T pscar =l sec. The control computer 
computation cycle time was T=0.0075 sec. Control law 
parameters were k/=0, k p =QM, and k^=19. 

Assuming now that the telescope was initially mispointed 1Q 
-1 degree=-0.01745 radian in both the elevation and cross- 
elevation axes, then the control algorithms, equations (1) 
thru (9), solved by the program (see lines 236 to 356) yield 
the following numerical results at T=1 sec. 

Av0 £e (l sec)=+0.01745 rad 15 

Av0 Xe (l sec)=+0.01745 rad 
AvQ, Ee (l sec)=0.0 
AvQ Xe (lsec)=0.0 

Avl Ee (l sec)=0.0 20 

AvI Xe (l sec)=0.0 

5^ p2 (1 sec)=0.146 rad/sec 

S£l RP3 (l sec)=0.146 rad/sec 

Over the next scan cycle the results are: 

25 

8Q RC (l + kT) = O.146cos(0j?c) - O.146sm(0* c ) 

= 0. 146cos (Q RC kT) - 0. 146Sin (Q RC kT) 

= 0.146cos(27tLT) - 0.146Sin(2jifc7) 

30 

where kT=0.0075 sec, 0.015 sec, . . . , 0.9925 sec. 

The nominal RUM rate, & RCN , is equal to 2n/T pscar =6.2S 
rad/sec. Hence the next scan cycle will have a total RUM 
rate of 

&rci{ 1 +kT) - Q. R cn + + kT) ^5 

= 6.28 + 0.146cos(2tcW) - 0.146Sin(2rafcr) 

It can be seen that by the practice of this invention the 
center-of-scan can be positioned accurately and automati- 4Q 
cally merely by the use of customary encoders and tachom- 
eters. In addition to utilizing RUMs for both pointing and 
scanning by the invention in order to eliminate the need for 
an auxiliary control system to keep the scan on target, a 
momentum desaturation system is not required. The RUMs 45 
do not momentum saturate as do reaction wheels and CMGs. 

And although a platform has been shown in the drawing for 
the purpose of illustration, RUMs used for pointing and 
scanning do not require gimbals and a base structure to 
torque against. A space-based, balloon-borne, or ground- 5Q 
based payload can be attached by means of a cable, a tether, 
or a rigid arm provided with a ball-and-socket or universal 
joint. The entire system is thus simplified. The use of RUMs 
for pointing and scanning insures that a gravity-gradient 
stabilized satellite stays pointed at the earth in spite of 55 
aerodynamic torques which tend to tumble or spin it. RUMs 
utilized as described herein can also potentially eliminate 
unwanted motions, such as skip rope motions and pendulous 
vibrations of tethered satellites. Use of RUMs for pointing 
and scanning according to this invention thus provides a 


far-reaching potential for the future of pointing control 
systems for free-flying spacecraft/satellites and space-based/ 
balloon-bome/ground-based payloads. 

What is claimed is: 

1. A method for positioning and repositioning, that is 
pointing, a scanning instrument when the instrument is offset 
from a center-of-scan thereof and must be pointed to that 
center, wherein the instrument is a type whose scanning is 
accomplished by rotating unbalanced-masses (RUMS) rotat- 
ing in fixed axes rotation relative to and associated with the 
instrument, and wherein the rotating unbalanced-mass 
instrument has first and second rotatable unbalanced-masses 
supported on respective drive shafts spaced from the center- 
of-mass of the instrument, and adapted to rotate 180 degrees 
out-of-phase with each other, with planes-of-rotation thereof 
parallel to each other, and at a constant nominal angular 
velocity so that centrifugal forces caused by rotation of the 
RUMs create a time-varying relatively large-amplitude/ 
high-frequency reaction forces and torques which act on the 
instrument to move its line-of-sight in a predetermined, 
repetitive, scan pattern, the pointing method including the 
steps of: measuring elevation and cross-elevation angles and 
the rate-of-change of these angles to determine any offset 
and offset time rate-of-change, calibrating magnitude and 
direction components of the offset about elevation and 
cross-elevation axes, converting these components to a 
RUM cyclic angular velocity component on top of the 
nominal velocity, and to a locus of the RUM 360 degree 
orbit where a peak of this cyclic component is to occur, 
accelerating the speed of the RUMS and decelerating the 
RUMs each cycle to produce the required angular velocity, 
thereby modulating the angular velocity to generate a torque 
which when combined with the high-frequency torque pro- 
duces a resultant torque vector each cycle whose direction is 
dependent upon the location of the locus in the RUM orbit 
where a peak of the cyclic component of the RUM angular 
velocity occurs, and which acts to compensate for the offset 
from the center-of-scan. 

2. The pointing method of claim 1 wherein the line-of- 
sight of the instrument is perpendicular to the planes-of- 
rotation of the RUM masses. 

3. The pointing method of claim 1 wherein the line-of- 
sight of the instrument is parallel to the planes-of-rotation of 
the RUM masses. 

4. The pointing method of claim 1 wherein the speed of 
the RUMs is gradually increased and decreased during each 
revolution to achieve the required magnitude and direction 
of the resultant torque vector for recentering the scan. 

5. The pointing method of claim 1 wherein the elevation 
and cross-elevation angles and their rates-of-change are 
differenced with desired values thereof and then averaged 
over each RUM orbit to determine the offset in the scan 
center and the time rate-of-change of this offset. 

6. The pointing method of claim 5 wherein the averaging 
and RUM angular velocity modulation steps are iterated 
over several cycles, with each approaching the required 
center-of-scan position, and continuing the iteration until the 
required center-of-scan position is reached. 

* * 



